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!■ Ifcll HBf » |im»U U«kal<M/ifor ooatrol 1 lag aaltlplo aaaipalatora 
vUok are koldlag a iligli ek/i«t i>4 tkinfori fora a oloeed kiaaaatia oka la. 

Tka object, vklak aay or aay aot bo la ooataot vitk a rigid oavlroaaoat, Is 
aaaaaod to bo bold rigidly by a robot ead~offeetora. Tko derivatioa la baaod oa 
sottlag ap ooaatraiat oqaatioaa vklok rodaco tko dxa dogrooa of froodoa of a 
aaaipalatora oaok kavlag all joint*. Addltloaal ooaatraiat aqiftlaai art 
ooaaldortd vkea oao or aoro of tko dogrooa of froodoa of tko objoot la rodaood 
dao to oxteraal ooaatralata. Utlllalag tko oporatloaal apaoo dyaaaloa 
oqaatioaa, a doooapllag eoatrollor la "aaigaed to ooatrol botk tko poaltioa aad 
tko latoraotloa forooa of tko objoot vltk tko oavlroaaoat. Fliilly^-vaapffmi: 

•iaalatioa roaalta for tko ooatrol of a pair of tvo-liak aaalpalatora^v^c^ — 4 

1. INTRODUCTION 

Tko toplo of aaltlplo robot ooatrol ia relatively aov la robot lob re tear ok. Tko exteaaloa of robot ooatrol 
toekaiqaoa to tko oaao of aaltlplo aaaipalatora la aoooaaltatod by/real Itiee oaooaatorod botk for aaaipalatiag 
aaall objoota aad for kaadllag largo vorkpioeoa. Tko aaaipalatjroa of objoota aoraally roqalroa at loaat too 
kaada to a iaal taaooaaly poaltioa aad roorloat tko objoot ao tkat oltkor oao or botk kaada oaa porfora tkoir 
respective taaka. loro, tko oaployaoat of aa extra ara la aired aot by lialtatioaa oa foroo/ torqae oatpat of 
aa ara bat by tko foot tkat la ooaplex took exeoatioa, tko jdorfcpleee aaat froqaoatly bo roorloatod to aspoao tka 
kard-to-reaok areas. Ia foot, aoao experts have a agar's ted tkat robota vill aot traly bo latagratad ia tko 
fatara factory oavlroaaoat aatil aaltlplo robot tap* plaaalag aad ooatrol have raaokod a oortala level of 
aatarity. Ia tkla paper vo vill oaly address tko eeptrol problaa aaaoolatad vltk aaltlplo aaaipalatora kaadllag 
a ooaaoaly kold objoot. Otbor probloaa, aaok ae/deveral aaaipalatora vorklag ia tko aaao vorkooll vltkoat 
aaaipalatiag tko aaao objoota aiaal taaooaaly, or/two area vorklag oa tko aaao objoota bat kav lag relative aotloa 
vltk roapoot to tko vorkpiooo, are laportaat rpdearek toploa aot addreaaod ia tkla paper. 

Barly vork la tkla area (1, 2) kaa aodtly dealt vltk aaator/alavo ooatrol tookaiqaoa. Tkla approaok 1a 
coaeeptaally aiapla. Oao aaalpalator \jr poaltioa aorvood vkllo tko otkar aaaipalator la foroo aorvood. Tko 
force aorvood era ia ooatrollod la oomrfiaat aodo to follov tko aaator (poaltioa aorvood) ara. Addltloaal food 
forward forooa (torqaoa) are added do tko foroo ooatrollod ara to roaliao tko roqairod latoraotloa forooa 
botvooa tko trai aad tko objoot vklok ia bo lag aaalpalatod. loro roooatiy, aaoag otkere. Lak aad Zkoag kavo 
reported tkoir vork la daal ara opardiaatioa. Vo will aoatioa oaly aoao of tkoir vork kero. Ia roforoaoo 13 J 
tkoy diaoaaa tko kiaoaatio Isaacs related to tko ooordlaatioa of daal aaaipalator robota. Tkoir approaok la 
baaod oa poaltioa aorvoiag of/oae of tko araa aad tko oao of kiaoaatio ooaatraiat oqaatioaa to aodify tko 
trajectory of tko eeeoad ara to roaliao oooporatioa botvooa tko araa. Ia roforoaoo (4j tkoy extead tkoir 
oaalyaia to iaolado tko eoadtraiat oqaatioaa for tko Joiat aceelerat ioa. Tbea, aaiag tko ara Jaooblaa. jolat 
torqaoa are eoapated to dqdivo tko araa. 

Ia tkla paper vo derive tko oqaatioaa of aotioa la tko ao-eailod Oporatloaal Spaoo (or Cartoaiaa atato 
apaoo) (Si. Vo aaaaao/a goaoral oaao of a eooperatlag robota vklok are koldiag aa objoot rigidly. Tkla object 
aay alao bo coaatraided froa aotloa la oao or aoro diaoaaloaa by aa oxtaraal oavlroaaoat. Bqaatloas of aotioa 
are derived aaiag tko Lagraago aaltipllor taokaiqao. Koforoaooa [41 aad r?) provide oxoolloat backgroaad for 
tkla foraala t loa/ It ia aaaaaod tkat oaok aaaipalator ia oqaippod vitk a foroo/torqao aoaaor eapablo of 
aoaaariag tkroo /rtkogoaal forooa aad torqaoa ia a glvoa eoordiaato fraao. Tko ala ia to ooatrol tko poaltioa 
of tko objoot add ita latoraotloa forooa vitk tko oavlroaaoat ia tko eeaee of hybrid ooatrol (tl. Tkla paper 
oxtoada tko prdvioaaly reported roaalta ia (9) by a aoro ooapaot foraalatioa aad by explicitly eoepatiag tko 
iatoraotioa forooa botvooa tko robota. Fiaally. a alaalatioa atady for a pair of tvo-liak eooperatlag 
aaaipalatora' ia proaoatod to validate tko aaalyaia. 
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monies or multi fl* cooruATma bosot iunifuutoss 


tm Uti MitiH, tt vill tki 4;n«i«i miiIUii far a «!om 4 Uiiaitii aha la forasd by a 

aniriliUfi rl|Uly intyiii u objiit. !• vill iniai that tosh aaaipalator has ais joiats aad that aoaa of 
tha aaalpalators axpariaaaa slagalarlty (i.a.. dogaaarata aaalpalatoi t Jaaobiaa) aa Uty favfora a task. Tha 
inifii ahjaat uy ha la aaataat with a rigid aaviroaaaat. 

la dariviag tha ifuttaai of aat ioa, va vill aaaaaa that thara aaiata a aoordiaata fraaa vhiah ia sttaahad 
ta tha ahjaat. Ia fait, ia tha matt saatloa, va vill aaa thia aoordiaata iraaa ta iHiify tha doairad aatiaa/ 
forao af tha ahjaat. Figaro 2.1 thavt a aahaaatia dravlag af thia aaltipla aaaipalator ayataa. 



Figaro 2.1. 

Tha darlvatloas of tha aqaatioas of aotioa ara ooaaldarably simplified vhaa i) va vaa tha Cartaaiam atata 
dyaaaios aqaatioas [3.10], aid h) va lmap tha ohjaat aass/iaartla imto that of tha aisth llmk of tha araa. 

Lot aa bagia vith tha vail kaova aqaatioa of aotioa for a aiagla aalti-liak ara [9,10] 

M(g) 1 ♦ X<g.g> ♦ 0(g) - t «•!> 

vhara g C t A daaotaa tha joiat atata vsrlabla. M(g)Gk“ a la tha iaartia aatris vhiah ia ayaastrla aad positive 
dafiaita, y(g,g)C* A ia tha aaatrifagal aad Corlolia foraa/torqaa vaotor, fl(g)€k* it tha gravity vector. aad 
xGt B la thajotat foraa/torqaa vaotor. Ia ordar to siaplify tha vordiag af tha papar, va vill aaaaaa that all 
tha joiata ara ravolate aad haaoa aaa tha tara "torqae" vhaa rafarriag to gaaaraliaad Joiat foraa/torqaa 
veetora. Tha ahova aqaatioa appliaa oaly to idaalisad friotioalaaa rigid araa. 

Ia tha first part of tha derlvatioa. va vill ooasidar aa object-fixed aoordiaata frame ralativa to vhioh 
tha dyaaaies aqaatioas vill ha vrittaa. fa will also aaaaaa that tha ohjaat haa baaa partitioaad iato a 
parts. Baah of thasa parts vill thaa ha ooasidarad aa a part of tha last llak of aaoh ara. Figaro 2.2 
illastrataa oae of thasa parts togathsr vith tha last llak of ara l. 
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/ 

\ 
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Flgara 2.2. Schematic draviag of tha partitioaad load aad its 
iatagratioa vith tha last llak of ara 1. 

If *J| is tha psaado- iaartia aatris of tha last llak raprasaatad la tha 1 ooordlaata fraaa. its rspresaata- 
tloa la tha B fraaa is ohtaiaad froa: 




last llak 


•li V -i 


( 2 . 2 ) 


Siaoa tha aras ara ooasidarad to ha rigidly attaokad to tha load, thara is a ooaataat traasforaatioa ralatiag 
tha i aad B fraaaa, |t. It thaa follows that 


- 


i - r f* ‘Xi) 1 - ?T 4 t 

J last llak 


(2.3) 


vhara E J i is tha pseado-iaar t la aatris of tha lost llak of tha ith ara asprassad ia tha E fraaa. Lat as aov 
assaaa that is tha psaado- iaartia aatris of tha ith partitioa of tha load. This aeaps that 
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wkiri fiftlftin i U ii ilivi MkiiitUiUy Im Fi|tn 2.2. Util It lag i(iittiii (2.9) ia4 (2.4), »• m mow 
4 i(1h a mow laat llmk for tki Ilk ua wkiok la ossoatiallp tki ooakiaatloa of tki origiaal last limk plat a 
port lorn of tko loaf. Alto moto tkat tko ooordiaato fraao of tko laat llmk la mow B iastoad of tk# fraao L 


Althoagk Im prlmolplo oma aaa ot# Jolmt tpaoo dpaoaloa oqaatloaa for tko apatoa of amltlplo maalpalatora. 
tko dorlvotiom la tomtidoraklp tiaplifiod wkoa tko sw-oallo4 oporatlomal tpaoo foramlatiom (or Car tot lam atato 
tpaoo dpmaaiot) it mao 4. Tko rolatlomaklp kotwoom tko Joimt tpaoo am4 tko Cartoaiam tpaoo foramlatiom oam ko 
dorirod aiaplp ky at ills imp tko mamlpmlotor laookiaa at [5,10] : 

i - 1(A) A <>.5) 


wkoro 1 it tko aamipmlatwr laooklam am4 j it tko poaltlom/orlomtatiom of tko loot limk oowrdimmta fraao. Tko 
laookiam ato4 koto It a g amoral omo, a oam imp tkat omo oam oomaldor it to ko 4oflmo4 rolatiro to tko laat fraao, 
tko worl4 fraao, or im foot amp otkor 4oairo4 fraao. Tkklag tko tlao dor laat loo of (2.5) roamlta im 

1 - 1(A) ft ♦ 1(A) 1 <2.4> 

Bmkotitmtimg 1 froa (2.4) lato (2.1), wo oktalm 

«(,) r^a) (X - ia) * Ka.a) ♦ fl(a) - s 

or 

“*<A> X ♦ I s <ft,£) ♦ fl,<A> “ t (2.D 

wkoro 

*,(*> " rT <2> *<i) rl <a) (2.D 

Y,<a.a> - J~H Ka.i) - *<a> J -1 **) i<a> a) <»•»> 

fl«(a> - J" T (a> 9 <a> (2,io> 

la oqaatloa (2.7), £ roproaoatt am oqairaloat goaorallstd foroo wootor appliod at tko oad-poiat (B-frtao). Lot 
as doaoto kp 1 tko latoraotioa goaoralisod foroo wootor oa oao of tko robot arat at tko B-fraao. Tko oqaatloaa 
of aotloa aro tkoroforo 


*ii<Ai> 1 ♦ X.i<Ai»fti) ♦ fl*i<ftl) - Ei + Xi . 1 - 1 » <2.11) 

Slaoo Xi' s th# lmtormal forooa oroatod at poimt B. tkoir tu la soro. 


a 

i Xi - o 
i-i 

Tko oqaotioa of aotioa, tkoroforo, a ap bo obtalaod bp oiaplp add lag tko oqaatloma (2.11) 

a a a a 

t 2 N, A (A ft )] X ♦ I Y.i^i.fti) ♦ I flsi<Ai) • I Ei 
1-1 1-1 l-l 1 1-1 

la ordor to aiaplifp tko aotatloa, lot as doflao 


( 2 . 12 ) 


*.<9> - j, "«l<*i> 

- Jj Y,i<4i.ii) 

9»<9> - j, > 

* • ill *» 

wkoro 

9 ■ ( *F. flj «I> 

Now. .qutio. (2.12) e» b. vritt.a i. tk* tiapl.r fora 

“,(9> X ♦ Y,<9.9) ♦ fl,(9> - E * 


(2.13) 

(2.14) 
(2.13) 


( 2.10 


* 
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Net* that N. it Mill a te.Ml.e d.fieit. aatrla. Tfc# Lt.raetlee |.a.r*U..d ferae*, l.e. Ij’e. *• 

•Miaul by aelelag fer 1 la eqaatlea (2.10 aa4 .mb.titati.f tk* reaalta la (2.11) 

Xi - n,i(«i> « - is<«.a> - s«wi 

♦ *«i<ai*ii> ♦ fl.i<*i> - Ei . » - » ■ «•«> 

Zm luairy, if tki iBiUldul JoUt torqaoa are |ltu, om on oospito tki otiUiloit Ei ## ^ atiliaiag (ko 
Jaeobiaa aatrloas. Bq aotioa (2.10 on that ko mi to a© loo tko forward dymasioa of the aaltiple ara ay a too* 
Finally, tko iattfootioo fore# a eaa ko eoapmted froa oqaatioa (2.17). Implicit ia tko above derivation art tko 
ooaatraiat oqaatioaa 

I * *i<Ii> • *2<«2 ) * *n<*> 

vkoro H 4 ia tko forward kiaoaatiea rolatioa for am i. 


s. tmomics of nultiiu ooofbxatino wtmcrr uMmumm * with sxtbxnal oonstkaints 

la tkia aootioa vo will derive tko oqaatioaa of aotioa vkoo tko object tkat ia boiag kol4 by a robot 
■aaipalatora ia ia ooataot vitk a friotioaloaa rigid eaviroaaeat. Lot C bo a ooordiaato fraaio oa tko objoot to 
roproaoat tko goaoraltso4 ooaatraiat forooa, Ilia ooordiaato fraao, ia general, will bo 4iatiaot froa tko B- 
frame. Witk a sligkt aodlf ioatioa. oqaatioa (2.14) oaa bo traaaforaod ao tkat tko gar rallied foroo vector l 
jo aa bo ropreaoated ia tko C fraao. If $T ia a koaogoaooaa traaaforaatioa tkat relat«a tko C fraao to tko B 
fraao, tkoa gj eaa bo obtaiao4 to rolato tko goaoraliso4 foroo veotora ia tkoao two fraaoa. Tko Jaeobiaa aatria 
§J ia given froa 

c* B> oORO x c* 

- (3.1) 

• &» J 


T . 


Ia goaoral, aiaoo tko C-fraao oaa bo tiao /arylng, and ooaaeqaently ^7 aro ala 


x doaoto tko poaitioa/orioatatloa of tko C-fraao. Tkoa 


S, ■ ? * ♦ B 1 * (l - 4) 

aad banco oqaatioa (2.16) ia 

«„<9> 31. ♦ Y„<9.9> ♦ 9 ie <9> - E, <3. 3) 

wb.r. M.., V 0.. era d.fla.d by . ..t of a.trix .qa.tioa. <?.»> - (2.10) with I r.p l.o.d by £/ *.d 

2 0 *C XC d 

E. * <§J) T E- 

Lot aa oasaao that i(| fl )Cl B , a X 6, roprosoata tko ooaatraiat foaotioa amok tkat 

q(j c ) - 0 V t 2 0 (3.6) 

If vo doaoto by £ 0 tko goaoral ixod coaatraiat forco vector, tkoa tko oqaatioa of aotioa la 

»,,<9> 2e ♦ Y,.<9.9> ♦ fize<9> ■ E« ♦ I. (}•!) 

Tko ooaatraiat forco f 0 oaa bo obtaiaod by noting tkat tko virtaal vork porforaod by X 0 it aqoal to soro 
aad by aaiag tko Lagraago anltiplior aotkod aa diacaaaod ia (61 aad (7). 


Tko atatoaont of virtaal vork ia 
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Proa tho ooi 


L«tioi (3.1) 


*#(*,) 


•l t - 0 


(3.9) 


Vo oao now net tho Lograage multiplier XC»" to relate (3.1) and (3.9) at 

_ _ **<*•> 

tij - X T 1 »» 0 - 0 

*1. 

Siaot ia aa arbitrary laflaitaalaal displacement vector, It la mot equal to soro. Therefore 
I, - D t <I 0 > X (1.10) 


vboro 

°<2') - **(«„> / 6l 0 (3.U) 

To f lad X. vo differentiate (3.0 with reepeet to tlao tvlao 

i(l 0 ) • D(i 0 ) J 0 - 0 (3.12) 

i(l^) - i(l*) i 0 ♦ D(I 0 ) x fl ■ o (3.13) 

amd •mbatitmta for X« froa (3.7) 

®<j«> i. ♦ d(i.) i e, ♦ » T <*.> * - is. (fl.fi) - fl ss (8> i • o 

•kick «1... X .. 

X - ( D(» # ) iqj(fl) D T (I,) )-l ( D(j # ) iqj(fl) IX M (fl.fl) ♦ fl g0 (fl) - E,j - D(* # > I, ) 0.14) 

Equation (3.7) togatbar with aqaatloa (3.14) completely ebaraatarlxa tha aqaatloa of aotloa of 
oooparatlag robot with aataraal aotloa ooaatralata oa tba objaot. 


ltipl 


4. CONTROL OF MULTIPLE COOPERATING tOBOTS 

la thla aaetloa va vill introduce a ooatrol taohalqaa which 1a based oa the oparatioaal apaca foraalatloa 

to coatrol tha poeltioa of tha object and lataraotloa foroaa of tha objaot with the aataraal oawlroaaaat. Tha 

approach presented hare is baaed on distributing tha actuation forces among tha eras such that sack ira 
contributes to tha aotloa of tha object and to its own inertial forces ia a predetermined manner. Let us begin 

by introducing a decoupling general isad force saoh that 

Ec - -U,d ♦ *fd<X.d - io> ♦ *fp<Icd - i«>l ♦ »..<9> [Sod ♦ Sd ( *od- *c> * Sp ( *.d - 

♦ Y,«(fl.i) ♦ flx.tfl) <4.D 

where Xcd * 1 desired lataraotioa force rector between the object and the extsraal environment. 

Ve auat now show that the above oholca for £ 0 does result in tha nultiple robotic system following tha 
apeclfied trajectory and applying tha deairad forces on the constraint surface. Ia order to simplify the 
derivation and without loss of generality, let ua ssaame that the poeition and force aubapacas are reordered la 
the aquations such that the first 6-n elements of the position vector correspond to the position controlled 
subapace and the laat m elements belong to the force controlled subspace. This means that, for example. 


197 


-•p?]:r 

r o I ) *- 

-tdi- 


Lot ii partition U* mi Mtrii M 


, *ai *21. 


-c :i 

,ktn MjjCl 4 "* 1 fltk tho ibava doooapooltloo of tko foraa-poottlaa oabopoooo, tko 0 attri* (*•• oqutloa 

3.11) can ba vrlttii as 

D(j c ) -C0l l mm 1 (4,7) 


»<«,) - 0 


*Uk tko .boo. okoioo for p(i # ). »• «•» »o* ooapoto tko oloood loop dymoaloo of tko aoltlp.o aaaipolotor oyotoa 
wltk E oo tko goaorol Ixod ooatrol foroo vootor gloom by oqaotloa (4.1). Lot ao partttloa tko ostool foreo. 
•ooalara tioa, and valooity vcotors aa 


fioll flail f**l' 

• la " • *« “ . 

LiolJ ll. 2 j L i#J . 


oad oloo ••loot t tf . K td . Ipp 


r° ° 1 r° ° i k* °i k* °i 

l fd • • f fp “ * Sp “ • S« " } 

L° k fpJ L° k fdJ ° °J L 0 °J 

where k^'i art diagonal aatrioea. Fran aquation ( 4 . 1 ) E 0 ia glvan by 

r ° 1 r ° ° ^ *.d k pd *p I" Sp *pl i 

L^od J L k fd if. , k fp *f. -° . . 0 - L 0 J 

akoro If - Xid " iol 1,4 ip “ lid _ *ol 


♦ x„ ♦ a* 


The raactlon forca X 0 ba oonpatad by substituting fro* aquation (4.11) for f 0 In aquation (3.10) and (3.14). 
After soma nanipulaiio* vf aqua t Iona, ona obtains 
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3. EXAMPLE 


la order to validate tht propoaad theory, a simulation a tody via undertaken. Tha aodol eoaaittvd ot 
simple plaaar robotio system composed of a pair of tvo-lluk revolute aaalpal a tora. Tha objeot vaa aaavaad to 
a poiat ana attachad to tka mppar lftak of aaok of tka aaalpal a tora. ace aach aaaipalator kaa oaly t 
dagraaa of fraadoa. tha objact vaa aaaaaad to ba ia aoataet with tka appar link* oaly through iataraotioa fore 
ratkar tkaa throagh forcaa aad ' orques. 

Tao eaaaa vara coaaidarad. la tka flrat eaaa it vaa aaaaaad that tkara vara no aavlroaaaatal coaatraiai 
This eaaa rapraaaata a para traaaport problaa vkara tvo aaaipalatora eooparata ia moving aa objact. Ia t 
aaeoad eaaa. aa environment vat attaaad vkiek raatrietad tka aotioa of tka objert in tha x direction. Ia bo 
eataa, tka daairad aotioa la tka y dlractioa vaa obtaiaad froa a eoaataat accalaratioa trajectory. Tka daair 
aotioa la tka x diraetioa vaa tat aqaal to tka iaitial s value (l.a., x ■ 0) ia tka flrat eaaa. aad tka daair 
Interaction force batvaaa tha objact aad tha environment vaa aat aqaal to zero la tka accoad eaaa. 

Tka simulation of closed kiaaaatic chelae caa altkar ba performed by computing tha iataractioo forcaa baa 
on tha dynaaica aqaatlont (aach aa thoaa developed ia thia paper) or by aaaaaing tha axiatanca of atiff tpriu 
(or apr ing-dashpot) at tha contact points. Since ia actaal experiments, one naaa forca/torqaa aanaora to obta 
thaaa interaction forcaa (torqaaa). tka aaeoad approach ia need in thia atndy. Figure 5.2 illuatratea t 
■odaling of tha contact aechanita batvaan tha nppar links and tha objact and betveen the objact aad t 
anvironaant. Figure 5.3 ahova tha overall aiaulatlon block diagram. 




Figure 5.2 Detailed Modeling of tha connections batvaan (a) tha arms 
and tha object, and (b) tha objact and tha external constraint 


Desired position 
and force _ 



Robot/ 

environment 

dynamics 

(Continuous 

system) 


A 


Desired position 
and force 

p. 


Figure 5.3 Simplified block diagram of the simulation study 

Although this paper does not attempt to address tha digital control aspects of the problem, the simulation stu 
vaa made more realistic by separating the continuous and discrete parts as shovn in Figure 5.3. 
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Figures 5.4 through 5.6 show 


the system for the following set of parameters and control gains 

link lengths 

• .04 (m] 

, equal for all lengths 

link masses 

- 4.0 U|I 

, for lower links 


• 2.0 (E|) 

, for upper links 

object mats 

• 2.0 (tf) 

• 

Initial joint angles: 

» n - 30° . 

* 12 - 120° 


» n • 150° , 

» 22 - -120° 

Position loop gains 

k pp - 4900.0 . 

*p4 ■ 9,0 

Force loop gains 

k fp - 1.0 . 

kfd ‘ 0 

Spring constants 

500,000 [N/a] for all of the springs 


140.00 [N/(b/,.c)1 

Sampling period 

1 asec 



Figure 5.4 shows the tricking capability of the object sioved by the eras. Since the difference between the 
position of the object and the tip of each upper link is insignificant, the plots show the desired va. actual 
position of the upper links. Figure 5.5 shows the tracking of the object in the second case (notion constrained 
in the x direction). Figure 5.6 shows the interaction forces between the object and the environment. The 
tianlation study indicates that the control algoritha developed in this paper yields excellent results. It nest 
be understood that several important practical probleas such as friction, flexibility of the links and joints, 
link parameter errors, etc., were not included in this simulation study. Further research and study is 
necessary to include such effects. 
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Figure 5.4 Pure Position Control with Cooperating Arms 
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PLOT of Load Position vs. TIME 
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Figure 5.5 Position Tricking in Posit lon/Forcc Control with Cooperating Arts 


LOAD-ENVIRONMENT INTERACTION FORCES vs. TIME 
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Figurs 5.6 Force Tracking in Position/Force Control with Cooperating Aras 


CONCLUSIONS 


This paper presented a theory for the position and force control of Multiple nsnipolators holding an object 
which is in contact with an environaent. The derivation is for n nsnipolators each having six degress of 
freedoa. The control is based on the Cartesian foraelation of the ara dynanics and extends the single-erm 
hybrid position/force control concept to the case of multiple aras. Siaple but realistic sianlation studies 
confirmed that the developed control concept results in excellent position tracking and force control. 
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IutitiU of Teekaology, aider contract vltk th National Aeroaaatics nt Spaa* Aiaiiiitntlot. 
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